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ABSTRACT 

The TAPS is a 2 axis gimbal system designed to provide fine 
pointing of STS borne instruments. it features center-of-mass 
instrument mounting and will accommodate instruments of up to 1134 
kg (2500 pounds) which fit within a 1.0 by 1.0 by 4.2 meter (40 by 
40 by 166 inch) envelope. The TAPS system is controlled by a 
microcomputer based Control Electronics Assembly (CEA) , a Power 
u ” rt ( PDU ) • and a Servo Control Unit (SCU) . A 

anrnlL 11 * iner ^®3 J reference unit is used to provide incremental 
ngles for attitude propagation. A Ball Brothers STRAP star 
tracker is used for attitude acquisition and update. 

The theory of the TAPS attitude determination and error computation 
Broad . Band X-ray Telescope (BBXRT) are described. The 
attitude acquisition is based upon a 2 star geometric solution. 

• ac ^ ulsl ^ :ion theory and quaternion algebra are presented. The 
attitude control combines classical position, integral and 

erivative (PID) control with techniques to compensate for coulomb 
friction (bias torque) and the cable harness crossing the gimbals 
(spring torque) . Also presented is a technique for an adaptive 
bias torque compensation which adjusts to an ever changing 
friction 31 torque environment. The control stability margins are 
detailed, with the predicted pointing performance, based upon 

simulation studies, presented. Finally the TAPS user interface, 

which provides high level operations commands to facilitate science 
observations, is outlined. 

NOTATION AND NOMENCLATURE 

Matrices will be written as bold faced capital letters, e.g. A. 
Vectors will be written as a lower case letter e.g. \r. The vector 
inner product will be written as <a,£> (i.e. a dot £) . Quaternions 
Vc noa^ written as lower case barred letters, e.g. g. a quaternion 
is used to represent a the TAPS coordinate system with respect to 
an inertial coordinate system. It may be expressed as a vector 
part and^ a scaler part. if we define a rotation about a unit 
vector, e, of angle <|>, it may be written as: 
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g = (sin-^ € , cos ) 


The inverse rotation is denoted g* and is formed by_ negating the 
vector part of g. For every attitude quaternion, g, there: « a 
unique equivalent attitude direction cosine matrix, A. For our 
nnrnoses^ a and A represent inertial to TAPS coordinate 
transformations . The column vectors of ^^^ ^e ^nertial basis 
vectors expressed in TAPS coordinates. It follows that the row 
vectors of A are the TAPS basis vectors expressed in inertial 

coordinates . 

ATTITUDE DETERMINATION 

When the TAPS is in parked or stowed position, its coordinate 
system is defined to be nominally parallel to the STS coordinate 
system. The x axis is the shuttle roll axis, positive for . 
The z axis points downward through the floor of the orbiter b y. 
The v axis Lints to starboard, forming a right handed cartesian 
frame. The inertial reference frame is the geocentric inertial 
coordinate system, 1950 mean (M50) . The components of the TAPS and 
its coordinate system are shown in figure 1. 

The attitude quaternion is initialized from the STS state vector. 
An attitude acquisition sequence is performed to remove the 
misalignments and uncertainties in the STS state vector. This 
sequence is discussed in the section on attitude acquisition. 

The quaternion is then propagated using a closed form solution to 

the kinematic equations of motion. 

_ ( 1 ) 
g(t+D = e 2 q(t) 

where, T is the propagation sample period, and Q 
symmetric matrix, 


Q = 


This solution assumes that the rate vector over the propagation 
interval is constant. By using the average rate over this 
interval, this approximation is close to ideal. The equivalen 
attitude direction cosine matrix, A, is computed each control cycle 
(16 Hz) . The input to these computations are the scaled, 
corrected gyro rates. 
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ATTITUDE ERROR COMPUTATION 


The attitude error is computed using the attitude direction cosine 
matrix, A, and the desired inertial target unit vector, S. The 
target vector is transformed into TAPS coordinates. 

rs . a 


7 TAPS 


= AS 


( 2 ) 


The required rotation vector is computed by taking the cross 
product : 

e = ^TAPS X & ( 3 ) 


where b is the reference unit vector in the TAPS coordinate frame, 
(the vector we are trying to point). in normal operations , £ = £ 
the BBXRT instrument boresight unit vector. During acquisition, 
b = b g the star tracker boresight unit vector. In all cases £ is 
nominally aligned with the -z TAPS axis. 


The magnitude of S is given by: 

|£| = l^ rAPS | |i?| sin 0 = sin0 


where 0 is the angle between S TAPS and £. We want the projection 
of 0 on the x and y axes. One way to do this is to normalize S as: 

s = -ijf = (©x/ e' y , e' z ) 


Now, S is the unit rotation vector, 
axis is then: 


x e = sin -1 1 el e* 


and for small 0, 


similarly. 


sin0 - 0 and: 


Vo ~ e y 


The projection of 0 on the x 

= 6e * 
sin 0 


( 4 ) 

( 5 ) 


For TAPS, 0 can be as large as 56 degrees. However, the control 
law limits the position error to a much smaller value which allows 
us to use this approximation. This is discussed in the attitude 
control section. 

ATTITUDE ACQUISITION 

The attitude acquisition sequence is designed to eliminate the 
alignment and other errors inherent in using the STS state vector 
Z? the TAPS attitude quaternion. The sequence assumes 
that the TAPS has been deployed to parked index position, nominally 
along the shuttle, -z axis, and that the shuttle state vector has 
been used to initialize the attitude quaternion. From that point 
the following steps are taken. 
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For each pair of stars: 


1) 

2 ) 


3) 

4) 

5) 

6 ) 

7) 

8 ) 
9) 


Slew on gyros to the first star. 

Store attitude information q lf £ lt where z x is the 
inertial TAPS z axis vector (the third row of the A 

matrix). ... „ 

Null on the star using star tracker position. 

Replace the attitude quaternion by the stored quaternion. 
Slew on gyros to the second _star. 

Store attitude information g 3 , £ 3 . 

Null on the star using star_tracker position. 

Store attitude information g 4 /£ 4 . 

Compute updated attitude quaternion from the stored 
inf ormatioru 


If there are more than two stars, 
subsequent pairs • In this case, 
the last star to remove residual 


we may repeat the sequence using 
we repeat steps 1) through 4) for 
roll and pitch errors caused by 


numerical computational errors. 


The mathematics of this acquisition sequence will now be explored. 
This analysis assumes perfect control, alignment (b - - z TAPS ), and 
sensors. We will use the subscript, t, to represent true attitude. 


At the start of the sequence, 

Let q t0 be the true attitude and let q 0 be our on-board 
attitude, such that _ 

QtO ~ <?0 QeO 

where q e0 is the error in initializing g 0 . The slew of 
our attitude sequence defines an attitude rotation, 

which, _ 

g 3 = <?o <7«i 


step 1) of 
q el , after 


and , _ _ 

q tl - QtO Qsi ~ <?0 ^eO Qsl * ^el 

The values of g x and are stored in step 2) . 

It is important to note that the first slew results in, 

e = 0 — A § x£ = 0 


Aiq,) £ = -£ 


TAPS 


( 6 ) 


Step 3) of our sequence produces the rotation q^i after which 

g 2 = Qm 


and. 


q t2 = <7tl <7/12 = <?i <7 e i Qm " <7a <7«2 
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( 7 ) 


Again note that the star tracker null results in, 

^ ( Qc 2^ g = ~ £ TA pg 

From equations (6) and (7) , 

AfqJ § = A(q t2 ) g 

so, 

§ = A'iqJ A(q t2 ) g = A(q t2 q[) g 

and, 

Qt2^i = Q m = Q. z 

where q_ z is some rotation about the g vector or, equivalently, the 
~ ^ taps vector expressed in inertial coordinates. 

We can thus write, 

" Q-zQ i 


Step 4) replaces the on-board quaternion q 2 by the stored 
quaternion q x . 

Proceeding with step 5 ) , 

Qt3 ~ Qt2 Qb 3 ~ Q-z &S3 = Q-z @3 

The quaternion, q 3 , and f 3 are stored in step 6). 

Step 7) yields, 

Qt4 = Qt 3 Qn4 = Q-z $3 Qnt = Q-z ^4 


In step 8) we store q 4 and 2 4 . 

We can compute the correction quaternion, q_ z , from the stored 
attitude information at the three corners of the spherical triangle 
defined by our sequence. Figure 2 shows the acquisition sequence. 
The angle T is the gyro slew from the star 1 to star 2 and the 
angle V is the angle between and f 4 . The angle P is the slew 

produced by nulling on star 2. The angle a is the error about ^ 
in q x . 

The quaternion q_ z is computed as follows. From figure 2 the angle 
a is given by: 

cosa = cos p - cosTcos^ 
sinT sinT' 

By assuming that T « r' we can make the simplification, 
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cosa 


cos 6 - cos 2 r 
sin 2 r 


where , 
and, 


cos T = <£ x , £ 3 > 


cos p = <£ 3 , £ t > 


We compute the quaternion q. e as: 


q_ z = (±sin f^cos -|) 


( 8 ) 


where , 


and, 


cos — = 
2 


N 


1 + cos a 


sin T = \| 


1 - cos a 


The sign ambiguity in (8) is resolved by setting the sign equal to: 
sgn{<£ x , (£ t - £ x )x(£ 3 - £ x )» = sgn{<£ x , £ 4 x£ 3 >} 


Note that the order of the cross product is chosen to provide the 
correct sign, since we are pointing the -z axis but storing the +z 
axis for use in these computations. The on-board attitude 
quaternion is then computed as : 

q = q. z q A 


This computation eliminates the z axis error. 

The effects of misalignments, gyro and star tracker quantization 
and noise, control errors, and STS inertial hold limit cycle motion 
have all been evaluated in simulation studies. These studies show 
that the worst case attitude acquisition error is approximately 2 
arcminutes . 

ATTITUDE CONTROL — BASIC 

In the x axis, the classic second order control law is, 

T x = ~(K p X e+ K r <* x ) UO) 

where T x is the x axis gimbal motor torque, and co x is the drift 
corrected, measured gyro rate about the x axis. Here, K p is the 
position gain and K z is the rate gain. They are chosen to achieve 
the desired control bandwidth, o> , and damping, C* The relations 
are: 
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Ci) 


and. 


C = 


*r 

(2 ®J„) 


where I ^ is the inertia about the x axis. 


For large rotations, we wish to limit the rate. 


(■> 


x> 


to 


1 degree/sec ( 


180 


rad/sec) . From equation (10) notice that when 




K <0 

w x 

K n 


T x = 0 


We can exploit this by limiting the magnitude of x e ~as 

x e = sgn[min(x lim , |xj) ,x e ] 


where , 


^lim 


_ Kr _jz_ 

K p 180 


For typical values of K z and K p , x lim is less than 1 degree and our 
small angle approximation is acceptable. 


When we are in the normal pointing mode, and the position and rate 
errors are small, we add an integral control term to compensate for 
torque hangoff effects. The TAPS basic control law is then, 

T x = ~(K p X e + K z Ci x + K i X z ) (11) 


where , 

= E*o 

Note that K ± must be adjusted from the continuous case by 
multiplying by the control interval, T, in seconds. This is 
because of the way we are approximating the integral of position. 

nT D iT 

fx 0 (x)dx = J^ J x e (x)dx 

0 1,1 (i-l )T 

By the mean value theorem, 

= x 6 (^ i ) - r£ X e (iT) = Tx j; 

i* 1 i-l 

The development for the y axis follows the above exactly. 

In order to allow slewing and to avoid stability problems, the 
integral compensation must only be added when we are truly holding. 
To accomplish this we compute the boolean variable: 
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HOLD := (|*J<P/uUd>A(|:?J<Pj !l o.Id> A ( |« *| <« AoJd ) A ( |o) y | <0> AoJd ) 

where, p hold and o > Aoid are the position and rate values we choose to 
consider the limits of hold mode pointing. When HOLD is true, we 
add in the integral compensation. When HOLD is false, we setx s 
and to zero and do not add the integral term. 

During attitude acquisition and update, we must be able to control 
the TAPS pointing based upon the star tracker error signals. To 
accomplish this x e and y e in equations (4) and (5) are replaced by 
x t and y t , the star tracker error signals. The rest of the control 
law is unchanged. 

The basic control law is also modified to limit the range, of 
motion. We must avoid gimbal contact with limit stops. We achieve 
this by providing a software limit of 19 degrees from the gimbal 
index position. When the position error exceeds 19 degrees minus 
our current gimbal encode position, in the direction we are moving, 
we replace the position error by this difference. For the x axis 
the logic is, 

if g_ra te x > 0 then 

if ( g_limit - g_position x ) <x e then 
x e := g_limit - g_position x 
gIsg 

if (- g_limit - g_position x ) >x e then 
x g := -g_limit - g_position x 

where g xate x , g_limit , and g_position x are the x axis tachometer 
rate, the gimbal software limit, and the x axis encoder angle 
respectively . 

ATTITUDE CONTROL — FRICTION AND SPRING TORQUE C OMPENSATION 

The modelling and early operation of the TAPS gimbal provided 
insight into the frictional torque characteristics of the gimbal. 
The gimbal physically exhibits friction, which may be approximated 
by a coulomb friction model, and a spring torque, due to the 
bending of the cable harnesses, which may be approximated by an 
angular hook's law spring. 

Early simulation studies demonstrated that we could not maintain 
the required 0.5 arcminute pointing jitter, during vernier thruster 
firings, with the basic control law alone. In order to improve 
this transient performance, 3 additional compensation terms are 
optionally added to the basic control law. These terms were a 
constant torque bias in the direction of motion, a spring torque 
term proportional to the gimbal encoder angle, and an adaptive bias 
torque term to correct for errors in the modelling and parameters 
of the other two terms. 

The bias torque term is given by, 
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( 12 ) 


T 'xbiaa Sgil ( K x bias' ^6^) 


The spring torque term is given by, 

T x spring = K x spring (ff_J>OSition x - g_ZerO x ) (13) 

where g_zero x is the encoder reference point for zero spring 
torque . 

The adaptive bias torque term is computed as follows, 

Tx adap^ ~ ^adapT X adap i + ^ x basic t (H) 

which is a first order difference equation in T xadap . In this 
equation, K a< j ap is chosen to be less than one for stability, andJC T 
if chosen as the inverse of the desired time constant to reach 
steady state. The torque, T xbagiCi , is the torque computed by the 

basic TAPS control law. A separate adaptive term is computed for 
each direction of motion, for each axis. If we assume a constant 
motion in one direction, 

T x basic y = T friction ~ T a( j a p. 

where T friction is a constant frictional torque to be overcome. The 
steady state solution of equation (13) is then given by, 

Txadap,! ~ Kf T friction 

where , 


X 1 " K adap + 

By proper specification of the gains, K f , the fraction of the 
frictional torque which will be removed by the adaptive torque 
term, can be selected. 

The final control law is then given by, 

T x = -(K p x e +K r (* x +K iX J + T xbiaa + T xepzing + T xadaptlve (15) 

ATTITUDE CONTROL — ANALYSIS 

Both the roll and pitch control loops are analyzed with appropriate 
rate, position and integral gains selected to provide at least 6 db 
of gain margin and approximately 30 degrees of phase margin. The 
analysis was performed using the Interactive Controls Analysis 
(INCA) program. The Nyquist frequency responses of the system are 
shown in figure 3 and 4. From the plots, the gain and phase 
margins are. 

Roll Axis 

Upper Gain Margin: 7.89 db at 11.7 radians/ second 
Lower Gain Margin: 11.5 db at 1.83 radians/ second 
Phase Margin: 28 degrees at 5.05 radians /second 
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Pitch Axis 


Upper Gain Margin: 7.76 db at 11.7 radians/ second 
Lower Gain Margin: 11.6 db at 1.84 radians/ second 
Phase Margin: 28 degrees at 5.12 radians/ second 

Once the gains were selected, planer simulations representing the 
shuttle and experiment interconnected via the TAPS were developed. 
The desire was to show that the pointing stability requirements of 
maintaining a peak pointing error of less than 0.5 arcminutes could 
be achieved in the presence of vernier jet firings. 


The MODEL translator was used to generate the FORTRAN rigid body 
simulations to evaluate the performance of the control laws 
developed in the above analysis. The x-z planer plant model 
equations, cast into matrix form, is given by, 

jf = T 

dt 


In this equation. 



where , 

X k x axis translational coordinate of shuttle 
Z k z axis translational coordinate of shuttle 
0 O k Shuttle y axis rotational coordinate 
Q g k Instrument y axis rotational coordinate 


and. 



motion 

motion 


where, 

F x k x axis component of vernier thrust 
F z k z axis component of vernier thrust 
T a k Shuttle y axis torque 
Tg k Instrument y axis torque 


and, 

f M.*M. 

o 8 
0 

M m 

W r r <* cos0 o i 

080 


0 M^cose^ 

M o* M , -MgT^iaO 0j 

-Af„r„sine oi 

-M^igBind gi cos0 Oj cos0 ffi +sinfl Oj sin0 ti ) 


W 508 ®* 

ine^ 

( cose 0l cose g * sine 0l sin6 gi ) 

hA* 1 , 


where, 

M 0 k Orbiter mass 
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M g A Gimbal and instrument mass 
I Q a Orbiter moment of inertia 
I g A Gimbal moment of inertia 

x cm A Distance from orbiter center of mass to gimbal axis 
i g A Distance from gimbal axis to center of mass of load 
0 O . a Initial shuttle y axis angle 

0 gj A Initial instrument y axis angle 
A similar set was developed for the Y-Z plane. 

For the simulation, a simple orbiter limit cycle was developed to 
illustrate the performance of the controller when the relative rate 
between orbiter and experiment changed sign. 

The initial conditions were established so that the orbiter was in 
a limit cycle at a rate of 0.02 degrees/sec with a dead-zone of 
± 0.5 degrees. The experiment was held inertially fixed while the 
orbiter was rotated underneath it. As can be observed in Figure 5, 
the experiment position error (top channel) exceeded 4 arcminutes, 
which is well beyond the 0.5 arcminutes pointing requirement, 
during the vernier jet firings. 

The same initial conditions as above were established for the 
results shown in Figure 6 with the adaptive bias logic enabled. 
Initially the position error peaks well beyond the 0.5 arcminutes 
pointing requirement whenever a vernier jet fires. However, after 
several jet firings the bias term has adjusted to the point where 
the friction level is compensated by the bias term and not the 
integrator . 

Illustrated in Figure 7 is the effect of a bias level nearly twice 
as high as required. The result is a temporary oscillation of the 
position error at the very beginning of the simulation run. The 
bias term being too high overdrives the experiment resulting in a 
switching between the positive and negative bias levels until they 
are adjusted to the appropriate value. 

The curves shown in Figure 8 illustrate the adaptive changes that 
are occurring in the positive and negative bias terms. Since the 
bias levels were selected to be nearly twice as high as required, 
the positive adaptive term must adjust to decrease the positive 
term. Similarly the negative bias term must adjust to decrease the 
negative bias. In order to avoid this temporary oscillation an 
initial bias level lower than the anticipated friction should be 
selected and allowed to adjust upward. 

Ideally the adaptive bias term is used to generate a torque that is 
equal to the friction level opposing the motion. Any torque 
opposing the motion that appears as a spring contaminates the bias 
capability. If such a spring torque exists in orbit, it will be 
possible to compensate for this torque by using the spring torque 
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control term. This will maintain the capability of the adaptive 
bias to effectively handle the friction level in the bearings. 

In the above linear analysis it has been shown that the basic 
control law is stable with adequate margins while the simulation 
has shown that the pointing requirement of 0.5 arcminutes can be 
met with the additions to the basic control law. 

TAPS USER INTERFACE 

One of the design goals of the TAPS system was to provide science 
experimenters a user interface which allows them to control the 
pointing of their instrument. The TAPS Ground Support Equipment 
(TGSE) provides a complete command and telemetry interface to the 
user. Commands may be composed and processed in real time, 
processed from a command disk file, or stored in on-board command 
timelines for timed, sequenced execution. Telemetry is captured, 
processed, and displayed in real time. 

The commands, called TAPS Mission Operations Commands (TMOCs) , are 
of high level with a descriptive, English-like syntax. A sampling 
of commands which are of interest to an experimenter illustrates 
this. 

Perform and inertial slew to a given M50 target vector: 

OPER ISLEW SI, S2 , S3 

Perform an inertial slew to a catalogued target vector: 

OPER CSLEW CATNO 

Note that experimenters need not be concerned with slew sequences 
about gimbal axes to acquire a target. Rather, they may specify 
targets in inertial coordinates. The TAPS takes care of the rest. 

CONCLUSIONS 

The TAPS has been designed to provide pointing of the BBXRT 
instrument to an absolute accuracy of better than 4 arcminutes, 
with a pointing stability of better than 0.5 arcminutes. The 
design of the attitude error computation provides for simplified 
user control of observations. The control law provides rate 
limiting to avoid gyro saturation and position limiting to keep the 
gimbals within an acceptable range of motion. 

It is our belief that the TAPS provides a flexible pointing 
capability which may be used for a variety of instruments. The 
system software has been designed in a highly modular fashion to 
allow the TAPS to accommodate other instruments and mission 
profiles. In particular, the architectural and algorithmic design 
required to point the Wide Angle Michelson Doppler Imaging 
Interferometer (WAMDII) instrument, which is an Earth limb pointer, 
had been completed prior to the suspension of the WAMDII program. 
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FIGURE 1 


354 











TIN* (tee) 


WITHOUT ADAPTIVE BIAS 



TIME (SEC) 

WITH ADAPTIVE BIAS 

POINTING PERFORMANCE 
FIGURES 5 & 6 


357 








1 I [ t I I I I I i I I I 

SOO 400 500 


Ttimu JIT TOOQOt 



POINTING PERFORMANCE 


JITIVI 1IAI C NJ M] 



| * 1 1 1 I 

200 300 

TIKI (SCC) 


i i i I 


ADAPTIVE BIAS CONVERGENCE 
EFFECTS OF INITIAL LARGE BIAS 


FIGURES 7 & 8 







